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results in frequency leakage being eliminated. 
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"A position monitoring system" 

Introduction 

5 The invention relates to a position monitoring system suitable for use in a variety of 
different applications, including medical applications, such as monitoring the position of 
an endoscope during colonoscopy, or monitoring hand movement. 

In recent years it has been recognised that internal medical examination is preferable to 
10 open surgical procedures for detecting illnesses such as colon cancer. While colonoscopy 
has less impact on a patient than open surgery, it is often quite painful because of 
movement of the endoscope through the colon. This may, for example, cause stretching 
of the bowel. As screening is becoming more common, there is pressure on medical 
personnel to increase the success rate above the current rate of c.90%, to make 
15 colonoscopy less painful for the patient and to reduce the time required. 

To address this problem it is known to provide a position monitoring system to monitor 
the location and orientation of an endoscope. United States Patent Specification No. 
US5913820 (BT) describes such a system. In this system a series of twelve 

20 electromagnetic sensors are mounted along the length of an endoscope. Fixed-location 
generators generate magnetic fields, inducing voltages in the sensors in the endoscope. 
For each generator, the generated magnetic field value and an estimate of the orientation 
of a sensor are used to determine an estimate of the distance from the sensor to the 
generator, and hence estimate the location of the sensor. The estimated location and the 

25 sensor-induced voltage is then used to estimate the orientation of the sensor, and this is 
then used as an input for the next location estimation. 

This invention is aimed at providing an improved position monitoring system. 
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Statements of Invention . 

According to the invention there is provided a position monitoring system comprising: 

5 a hardware layer comprising a plurality of electromagnetic generators, at least 

one sensor and a sample processor for generating sample data; and 

a system layer comprising a position processor for generating position data from 
the sample data; 

10 

the system being configured:- 

for simultaneous operation of the plurality of electromagnetic generators, 
with the plurality of electromagnetic generators operating at different 
15 frequencies; and 

for synchronised operation of the plurality of electromagnetic generators. 

In one embodiment of the invention the plurality of electromagnetic generators are 
20 configured to operate in a fixed phase relation. Preferably the hardware layer comprises 
a sampling clock, and the system is configured for synchronised operation of the 
sampling clock and the plurality of electromagnetic generators. Ideally the 
electromagnetic generator is configured to generate an electromagnetic waveform, and 
the electromagnetic generator is configured to generate one or more full electromagnetic 
25 waves within each sampling window. Most preferably the plurality of electromagnetic 
generators are configured such that at the beginning of each sampling window the 
amplitude of all of the generated electromagnetic waveforms is equal. In one case the 
plurality of electromagnetic generators are configured such that at the beginning of each 
sampling window the amplitude of all of the generated electromagnetic waveforms is 
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The sensor may be configured to be mounted on an object, the position of which is 
desired to be monitored. 

5 In one embodiment at least one sensor is of the magnetoresistive effect type. 

In another case the electromagnetic generator comprises a coil generator. Preferably the 
electromagnetic generator comprises a set of 3-D generator coils. Ideally the plurality of 
electromagnetic generators are driven by an oscillator circuit. Most preferably the 
10 oscillator circuit comprises a synchronous oscillator circuit. The oscillator circuit may be 
configured for control of the oscillating frequency and phase by a reference signal. 

In a preferred embodiment the hardware layer comprises at least one reference sensor at a 
fixed position relative to the plurality of electromagnetic generators. 

15 

The sample processor may be configured to generate a series of readings for a channel 
from each sensor. 

In one embodiment the sample processor is configured to extract the components of a 
20 signal, received from the sensor, corresponding to each generator. Preferably the sample 
processor is configured to frequency multiplex the signal received from the sensor. 

Ideally each electromagnetic generator is configured to operate at a unique frequency. 

25 In another embodiment the sample processor comprises a Discrete Fourier Transform 
(DFT) function for generating sample data. Preferably the sample processor comprises 
an interface for receiving digitised sensor samples and an input buffer for retrieving 
sample words in parallel from the interface. Ideally the interface shifts bits as fresh bits 
are received, and the input buffer retrieves words of a pre-configured length. Most 

30 preferably the sample processor comprises a vector table for providing parametric data to 
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the DFT function. The parametric data may be calculated according to frequency of 
operation of the generators and sampling frequency. 

In a preferred case the DFT function windows time series incoming samples with a band 
5 limited waveform. 

The sample processor may comprise an FPGA. 

The sample processor may comprise a DSP. 



In one embodiment the system layer comprises an embedded processor. 

Preferably the position processor is configured to generate the position data using only 
some of the sample data. Ideally the position processor is configured to generate the 
15 position data using only the sample data having the largest amplitude. 

The position processor may be configured to generate position data by: 



10 



(a) 



estimating three-dimensional position and orientation data; 



20 



(b) 



determining actual three-dimensional position and orientation data; 



(c) 



determining speed of movement; and 



25 



(d) 



using the results of steps (b) and (c) of a previous measurement iteration 
as an input to step (a) of a next measurement iteration. 



Preferably step (b) is performed with recursive computing. 
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In one case the position processor is configured to limit the range of the position 

i 

calculation by: 

5 

where: 

V s = amplitude of a signal received from the sensor; 

10 R = distance between the sensor and a generator; 

k c , k s = constants; 

Dx, Dy, Dz = three-dimensional position of the sensor; 

15 

a = orientation of the sensor. 

In a further embodiment the hardware layer is configured to supply power to each 
electromagnetic generator at a power level responsive to the position data generated by 
20 the position processor. 

The hardware layer may be configured to enable the frequency, at which each 
electromagnetic generator may be operated, to be altered. Preferably the system 
comprises means to analyse the difference between a signal from the sensor before 
25 altering the frequency and a signal from the sensor after altering the frequency. 

In one case the system comprises an application layer comprising at least one application 
for processing the position data. Ideally at least some applications of the application 
layer are remote from the system layer. 

30 
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The position monitoring system is suitable for monitoring the position of a probe in a 
body passageway. The position monitoring system is particularly suitable for monitoring 
the position of a colonoscope in a colon. 

5 In another aspect, the invention provides a method for monitoring the position of an 
object, the method comprising the steps of:- 

providing a plurality of electromagnetic generators and at least one sensor; 

10 arranging in a fixed position either the plurality of electromagnetic generators or 

the at least one sensor; 

arranging for either the at least one sensor or the plurality of electromagnetic 
generators to be carried by the object; 

15 

simultaneously operating the plurality of electromagnetic generators, at different 
frequencies, in a synchronised manner; 

generating sample data from the output of the at least one sensor; 

20 

generating position data from the sample data to monitor the position of the 
object. 

In one embodiment the plurality of electromagnetic generators are operated in a fixed 
25 phase relation. Preferably a sampling clock and the plurality of electromagnetic 
generators are operated in a synchronised manner. Ideally the electromagnetic generator 
generates an electromagnetic waveform, and the electromagnetic generator generates one 
or more full electromagnetic waves within each sampling window. 
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In another embodiment the plurality of electromagnetic generators are arranged in fixed 
positions, and the sensor is arranged to be carried by the object. Preferably the sensor is 
mounted on the object. 

The plurality of electromagnetic generators may be driven by an oscillator circuit. 
Preferably the method comprises the step of using a reference signal to control the 
oscillating frequency and phase of the oscillator circuit. 

In one case the sample data is generated by extracting the components of the sensor 
output corresponding to each generator. Preferably the sample data is generated by 
frequency multiplexing the sensor output. 

Ideally each electromagnetic generator is operated at a unique frequency. 

The position data may be generated using only some of the sample data. Preferably the 
position data is generated using only the sample data having the largest amplitude. 

In a preferred case the position data is generated by: 

(a) estimating three-dimensional position and orientation data; 

(b) determining actual three-dimensional position and orientation data; 

(c) determining speed of movement; and 

(d) using the results of steps (b) and (c) of a previous measurement iteration 
as an input to step (a) of a next measurement iteration. 

Ideally step (b) is performed with recursive computing. 
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Desirably the method comprises the step of limiting the range of the position calculation 
by: 

5 

where: 

V s = amplitude of a signal received from the sensor; 

10 R = distance between the sensor and a generator; 

k c , k s = constants; 

Dx, Dy, Dz = three-dimensional position of the sensor; 

15 

a = orientation of the sensor. 

In a further embodiment the method comprises the steps of supplying power to each 
electromagnetic generator at a power level responsive to the generated position data. 

20 

The method may comprise the step of altering the frequency, at which each 
electromagnetic generator is operated. Preferably the method comprises the step of 
analysing the difference between the sensor output before altering the frequency and the 
sensor output after altering the frequency. 

25 

In a preferred embodiment the method comprises the step of processing the position data 
to control an application. 

The method is suitable for monitoring the position of a probe in a body passageway. The 
30 method is particularly suitable for monitoring the position of a colonoscope in a colon. 
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Brief Description of the Drawings 

5 The invention will be more clearly understood from the following description of some 
embodiments thereof, given by way of example only, with reference to the accompanying 
drawings, in which: - 

Fig. 1 is a high level diagram illustrating architecture of a position monitoring 
10 system according to the invention; 

Figs. 2 and 2(a) are block diagrams illustrating the system of Fig. 1 in more detail; 

Fig. 3 is a flow diagram illustrating operation of the system of Fig. 1 ; 

15 

Fig. 4 is a diagram of an alternative position monitoring system according to the 
invention; 

Fig. 5 illustrates waveforms of two generators, one sensor, and a sampling clock 
20 of the system of Fig. 1; 

Fig. 6 is a flow diagram illustrating operation of an interface part of the system of 
Fig. 1; and 

25 Fig. 7 is a circuit diagram of an oscillator circuit part of the system of Fig. 1. 



30 
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Detailed Descri ption 

Referring to Fig. 1 a position monitoring system 1 according to the invention has a 
modular three-tier structure of: 

5 

* 

2: a hardware layer for generating the underlying signals using electromagnetic 

generators and sensors, 
3: a system layer for taking the sample signals and generating position and 

orientation data, and 

10 4: an application layer which uses the position and orientation data to generate 

outputs for a particular medical application, such as monitoring the tremor in a 
hand of a Parkinson's Disease sufferer. 

Referring to Fig. 2 the hardware layer 2 comprises three fixed-location sets of 3-D 
15 generator coils 10. Each coil 10 has a unique, dedicated frequency of operation, and has 
a power consumption of between 0.1W to 10W (RMS) adjustable according to the 
working range. Each coil 10 can thus be battery-powered and portable. The frequency of 
each of the coils 10 is selected to ensure that the sampling set, in this case 640 points, has 
a number of full sine or cosine waves within the sampling window. 

20 

For example, a setup can be the following 9 frequencies for 9 coils: 10kHz, 9.750kHz, 
9kHz, 12kHz, 11.500kHz, 10.250kHz, 11.750kHz, 8.500kHz, and 10.750kHz. If the 
digitising sampling rate is 32 kHz and the data set length is 640 points, then the 10kHz 
frequency generator coil 10 will produce the number N of full waves within the sampling 
25 window given by: 

N = coil_frequency x (frame Jength / ADC_sampling_rate) 
= lOkHzx (640/32kHz) 

30 
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= 200 full sine waveforms within the sampling window 

Similarly, the generator coil 10 with a frequency of 11.750 kHz will produce: 

5 N = 11.750kHz x( 640 /32kHz) 

= 235 full sine waveforms within the sampling window 

The actual measurement from a sensor 11 is the compound of all these 9 frequencies. 
10 Each frequency will be extracted using the Discrete Fourier Transform (DFT) signal 
processing algorithm. 

The field generators 10 are driven synchronously with a reference clock in a method 
comprising the steps of: 

15 

i) A Synchronous oscillator (SO) circuit drives the field generators 10. 

ii) Disable the injection signal to make the oscillator free running. 

iii) Measure the free running frequency. According to this frequency, estimate the 
tracking frequency range of the SO. According to this range determine the 

20 working frequency of each element of the field generators 10. 

iv) Monitor the working of the SO, repeat step ii) and iii) when required. 

A power synchronous oscillating circuit is used to drive the generator coils 10. Its 
oscillation is synchronized to the coil control clock. 

25 

As the temperature and time can change the characteristics of the SO circuit, the tracking 
frequency range of the SO may drift from time to time. Step (iv) above ensures correct 
operation of the SO. If the drift makes the working frequency of an element outside of 
the tracking range, step (iv) can reset the working frequency. 
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The SO circuit drives the three coils 10 of each generator set. The inductors for the coils 
10 are chosen to generate powerful driving of the coils 10. The coils 10 may have the 
electrical characteristics as listed in Table I. 

5 Table I. 



Coil Phase 


Inductance [jxH] 


Resistance 


A 


247.4 


2.1 


B 


246.2 


2.2 


C 


262.0 


2.2 



In one case, the generator phases generate 50V and 2.9 A (peak-to-peak) at the operating 
frequency of circa 10 kHz and operating battery voltage of +5V. The drive MOSFET 
10 transistor consumes 145 raW. Coil heat dissipation is 0.528A per phase @ 5V operation 
= 2.64 W per phase. 



There are n 1-D sensors 11, where n is up to 64, mounted on the device being monitored, 
such as an endoscope. The sensors 1 1 are magnetic field sensors of the type marketed by 
15 Philips under the code KMZ10A™. Each sensor 11 is based on the magnetoresistive 
effect of thin-film permalloy in a Wheats tone bridge configuration of four resistors. A 
voltage is applied to the bridge, and the bridge output changes in the presence of an 
applied magnetic field. The sensors 11 are packaged items and so are particularly robust 
and predictable. 

20 

The output of each sensor 11 is fed through a signal conditioning circuit 12 and an 
analog-to-digital (A/D) converter 13. The latter provides 640 samples of 24 bits each for 
each reading for each channel. 
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There may also be reference sensors fitted at fixed positions relative to the generators. 
Such reference sensors may be used to detect the strength of the magnetic field generated, 
and hence provide field strength parameters for position calculation. 

5 A dedicated FPGA 15 processes the digital outputs of the A/D converters 13 to provide a 
series of readings per channel. Within the FPGA 15, an interface 16 controls flow to an 
input buffer 17 using a set of serial to parallel converters connected to an I 2 C bus. 

The interface 16 is provided in the form of a USB interface between the A/D converters 
10 13 and the input buffer 17. The architecture of the USB interface 16 is illustrated in Fig. 
6. 

The USB interface 16 performs the following tasks: 
15 Configures the FPGA logic; 

Transfers data from A/D interface; 

Sends control commands and checks the system status. 

20 

The Discrete Fourier Transform (DFT) block 18 processes one of the 640 readings for all 
n channels in one cycle. The input buffer 17 holds only one sample for all n channels at 
any time, and is immediately refreshed with the next sample. The interface logic 16 
stores the intermediate data. Each sensor sample is digitised to a 24 bit binary code. For 

25 example, 00001 111_10101010_1 1001 100. The wiring connection to the system digitiser 
(Analogue-to-Digital Converter) is a single-bit stream serial port, while the interface to 
the input buffer is a 24 bit parallel connection. So when the first bit is moved into the 
interface 16, it has a data of Oxxxxxxxxxxxxxxxxxxxxxxx. After 4 bits, it is for 
example 1 lOOxxxx xxxxxxxx xxxxxxxx. After 8 bits, it is 

30 1 1001 100_xxxxxxxx_xxxxxxxx. When all 24 bits have moved in, the interface 16 holds 
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00001111_10101010_11001100. At this timing, the input buffer 17 will be instructed to 
get the 3 -byte data word. Since the data in the interface 16 is always shifting, this buffer 
is used to hold a stable and valid 24 bit sample data. The result of the computation of the 
DFT 18 is stored in the result buffer 19, providing spectral results for each of the n- 
5 channel sensor inputs. The spectral result of a sensor has the same number of frequencies 
as the number of the generator coils, for example, if there are 9 generator coils 10, then 
the spectral result for each sensor 11 will contain 9 frequency measurements, i.e. the 
sensor amplitude and phase information for each generator 10. 

10 A twiddle vector table 20 provides parametric values for the DFT 18 calculation as 
follows. The parametric data is computed according to the working frequency of the 
generator coils 10. For example, if one coil 10 works at 10kHz and sampling frequency is 
32kHz, for calculating the DFT of 640 points, we need to have some values of the sine 
function (also called Twiddle Factor). Let w = 2 * PI * 10 kHz / 32kHz, the table will 

15 have the value of sin(w), sin(2w), sin(3w) ... sin(639w). 

This example only shows the table data for 10kHz coil. For other coils there are similar 
sets of sine look-up data, which together form the whole data of the vector table 20. Since 
the working frequencies of the coils are set at run-time, this table is also setup at run- 
20 time. And it only needs to be setup once at the system startup/reset stage. 

The generator coils 10 are driven simultaneously, with each coil 10 having a different 
frequency. These frequencies have a fixed phase relation at the beginning of a sampling 
window, and are synchronised with the ADC sampling clock. This arrangement ensures 
25 that in one sampling window for DFT, there are exact integral numbers of full waves in 
each window. As a result this eliminates frequency leakage during the spectral analysis 
by DFT. The fixed starting phase of the frequencies helps to compensate the offset in the 
analog channel as well as to determine the orientation of the sensor. 
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An example of the ADC sampling window is given in Fig. 5. Generator coil 1 and coil 2 
are of different frequencies, and their phase is precisely controlled by the digital control 
clock. For a sampling window, all of them start from an amplitude of zero in this 
example. ADC sampling is conducted according to the A/D sampling clock. In this 
5 example, there are 50 A/D samples, and within this sampling window there are exact 
integral number of full sin waves for both coil 1 and coil 2. 

The waveform for coil 1 and the waveform for coil 2 operate in a fixed phase relation. In 
particular, in each sampling window, the starting phase of both of the waveforms is fixed. 

10 

An example of the sensor signal is also given in Fig. 5. It will be appreciated that the 
exact shape of the sensor signal depends on the position and orientation of the sensor 11. 

It will be appreciated that the form of the wave for coil 1 does not need to be identical to 
15 the form of the wave for coil 2. For example, coil 1 could be a sine waveform and coil 2 
could be a cosine waveform. 

In this specification, the term 'frequency leakage' is defined as a signal of one frequency 
being found in its neighbour frequency after the conversion, for example, a signal of 
20 9,999Hz being moved to a neighbouring bins such as 10,000Hz, 9,000Hz, or 11,000Hz. 
Frequency leakage has in the past been caused by the discontinuity between the end and 
the beginning of the data in one sample frame. To overcome such frequency leakage, 
windowing has in the past been applied to samples. 

25 The DFT algorithm converts a time domain signal into the frequency domain. Frequency 
leakage is a defect found when the DFT algorithm is used on un-windowed time series. 
The result of the DFT is to create spectral outputs in the wrong frequency positions which 
are erroneous. For example, a time series of signal data may have a significant 
component at a frequency of 9,999Hz. Due to frequency leakage this component may be 
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assigned to 10,000 Hz rather than 9,000 Hz. For example, sample(O) = 0, but 
sample(640) = 1000. 

The synchronised operation of the generator coils 10 eliminates frequency leakage during 
5 DFT operation, and makes fast calculation of the position of the sensors 11 possible. The 
DFT can convert a signal from time domain to frequency domain while avoiding 
frequency leakage. 

In the system according to the invention, by ensuring a complete number of full sine or 
10 cosine waves in one DFT frame, by which the continuity between the end and the 
beginning of the data in one sample frame is guaranteed, there is no signal leakage and no 
need for windowing and no need to calculate neighbour bins, which saves computing 
time, as well as improving the accuracy of the measurement. Therefore, operation of the 
DFT 18 is particularly fast. For example, if the sample(O) = 0, since we have complete 
15 number of full sine or cosine waveforms in one frame, the sample(640) = 0 is forced to 
also be true. So there is no leakage. The fact that there is no leakage will speed up the 
spectral analysis calculation. 

An advantage of the system of the invention is that the generators are driven 
20 synchronously with the sampling, and so frequency leakage is avoided. 

In addition, the phase relation of the generator driving frequencies is fixed. This fixed 
phase relation assists in determining the orientation of the sensor. For example, if the 
sensor is rotated by 180 degrees from a first orientation to a second orientation, the 
25 amplitude of the measured sensor signal will be the same in both the first orientation and 
the second orientation. However the phase of the measured sensor signal will change 
from when the sensor is in the first orientation to when the sensor is in the second 
orientation, and thus the system can determine that the orientation of the sensor has 
changed. 

30 
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The system also enjoys operational advantages as a result of the plurality of 
electromagnetic generators being driven by an oscillator circuit. In particular, the 
oscillator has a higher efficiency and a simpler structure, compared to for example an 
amplifier circuit. Further the oscillator circuit operates under control of a reference 
5 signal. 

The oscillator circuit delivers high power, and oscillates synchronously with a reference 
signal, and is therefore know as a Power Synchronous Oscillator (PSO). The circuit 
diagram for the PSO is illustrated in Fig. 7. 

10 

At the hardware level 2 the driving of the field generators 10 and the sampling is derived 
from the same clock. By carefully allocating the driving frequency and the sampling 
length, an even number of sine or cosine waveforms can be obtained in one sampling 
frame. 

15 

The DFT calculations are based on the sample data. The values represent both the 
amplitude and the phase of each driving element. 

Referring to Fig. 2(a), the system layer 3 comprises an embedded processor 25 which 
20 takes the output of the result buffer 19 and generates location and orientation data for 
each sensor 1 1 . 

The basic flow is illustrated in flow diagram form in Fig. 3 as a method 30. After getting 
the DFT result in step 31, the processor 20 estimates position and orientation in step 32. 
25 An estimated position component X n * is estimated as the previous position component 
X n _i plus the speed times the movement (change in location). Recursive computing of 
step 33 is performed to generate location data X, Y, Z, for each sensor and orientation 
data a, 6. This in turn is used to generate a speed value in step 35, subsequently used in 
step 32 of the next loop. 

30 
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The resultant position monitoring information is particularly useful, real time position 
information for an application such as monitoring the location of an endoscope within a 
colon. 

5 The system also includes an on-system user control panel to facilitate control of the 
system, during use. The control panel includes a 16 x 2 character PLED display. The 
PLED display provides enhanced display quality. The interface is connected via FPGA 
logic. The control panel also includes a 6-key keypad. All keys can be individually read 
by the firmware/software, via the FPGA logic. A power switch is also provided to 
10 control the on/off status of the ATX power unit. The control panel also includes a 
buzzer. The buzzer is controlled directly by the MCU, so that it can provide debug 
information when the FPGA is unavailable. A reset button is also included. The button 
can reset the MCU, and hence restart the whole system. 

15 The application layer 4 has software which processes the location and orientation data 
according to algorithms for particular applications. Such an application may for example 
monitor tremor/vibration of the hand of a patient suffering from Parkinson's disease. In 
this example, the hardware layer 2 comprises a glove with sensors 1 1 located at positions 
on the fingers and at chosen positions elsewhere on the hand. Because of the frequency 

20 multiplexing and the speed of operation of the FPGA 15, it is possible to achieve about 
50 to 100 readings for all sensors 11 per second. 

For colonoscopy, the sensors 1 1 may be mounted along the length of an endoscope. 

25 The system 1 could also be used in position monitoring in other parts of the digestive 
tract, or for navigation of a probe through other passageways in the body, such as 
cerebral passageways. 
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Other applications of the system 1 according to the invention include a telephone for deaf 
people using a standard telephony system. Another application is a 3D input device for a 
virtual reality system. A further application is movement analysis for sports. 

5 Because of the nature of the system, wireless interfaces may be used. Such a scenario is 
illustrated in Fig. 4, in which a hardware layer 50 communicates via a wireless interface 
51 with a system layer 52. The latter has a computer network interface for Internet 
communication with applications 54 and 55. This allows excellent versatility in use of 
the system. For example, a physician may remotely monitor a patient who is at home. 

10 In the example of Fig. 4, a single hardware layer 50 supports multiple applications. For 
example, a physician can use one application (local) to assist with a procedure, another 
application can record the location data into a database for later access, while a lecturer 
could use another application to show his students how the procedure should be 
undertaken. Also, a system-layer unit may have sufficient processors to process data 

15 from multiple patient hardware-layer systems, and the links to the hardware are 
conveniently wireless. 

In another embodiment, the wire of the generator coils is doubled in size, and the 
windings are double rather than single layer to achieve the same turns. By doubling the 
20 wire size, this results in lower resistance, and therefore less DC heating effect by a factor 
of 4 times lower. 

These generator coils produce about the same AC power and hence the same magnetic 
field strength of 46 V and 3.7 A (peak-to-peak) for +5V DC battery operation. Coil heat 
25 dissipation however is much lower, i.e. 0.182A per phase @ 5V operation = 0.91 W per 
phase. These coils provide a reduction in power loss of 65.5% which may be particularly 
advantageous. 

These generator coils may have electrical characteristics as listed in Tables II-l, II-2, II-3. 
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Table II-l 



Coil Phase 


Inductance [u.H] 


Resistance [Si] 


A 


171.8 


0.4 


B 


181.0 


0.4 


C 


192.3 


0.4 


Table II-2 


Coil Phase 


Inductance [\xH] 


Resistance 


A 


173.0 


0.4 


B 


184.0 


0.4 


C 


188.8 


0.5 


Table II-3 


Coil Phase 


Inductance [jj.H] 


Resistance [Q] 


A 


172.2 


0.4 


B 


174.3 


0.4 


C 


185.4 


0.4 



In another embodiment, to determine the error factor associated with a generator coil, the 
following steps may be performed:- 

15 

a plurality of sensors are precisely fitted at known positions, to form a calibration 
platform; 
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the generator-under-test may then be fitted precisely at another known position; 
and 

by analysing the measurement of the signal from the sensors, the non- 
5 concentricity and the orientation error of the generator coil can be determined. 

During the 3D position calculation, such errors associated with the generator can be 
corrected by matrix operation. 

10 In another embodiment, the amplitude of the sensor signal may be evaluated and used to 
control the power supplied to each generator. The further the sensor is located from a 
generator, the higher the power supplied to drive the generator. The purpose of such 
generator power control is to increase the operating range while minimising power 
consumption. 

15 

When there is metal mass within the operating range, an eddy effect may occur, and as a 
result the AC magnetic field generated may become distorted, and the accuracy of the 
position measurement may be adversely affected. To overcome this problem, in another 
embodiment, the operating frequencies of the generator coils 10 may be swapped among 
20 each other from time to time. As the eddy effect caused by AC magnetic field varies 
according to the frequency, by analysis of the measurement difference between the sensor 
signal before the switching and after the switching, a compensation matrix can be 
established. As a result, the effect of the metal mass to the accuracy of the position can be 
significantly reduced. 

25 

In another embodiment of the invention, the 3D position calculation, which is based on 
numeric optimization method, may include the following steps :- 

1. Process the sensor signal (including filter, DFT) to get measurements from the 
30 generated magnetic field. 



WO 2004/096042 PCT/IE2004/000062 



10 



15 



25 



-22- 



2. Based on the value of the processed signal, choose the measurements of at least 
two generator sets for further processing. 



3. Normalize the value based on the parameter measured by reference sensors 



4. Calibrate the generator non-concentricity error by means of matrix operation. 



5. Calibrate the field distortion caused by metal mass. 



6. Decide the position range of the sensor, by means of the following equation that 
links the magnitude of the measurement and the distance of the sensor: 



where V s is the amplitude of the field measured, 



R is the distance from the generator to the sensor, and 



20 kc, ks are constant factors. 



The maximum and minimum R can be determined by: 



vi+3oos 2 ac=2 and 



Vl+3 cos 2 a=l 



respectively. 
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By intersecting the Rmax and Rmin of different generators, a position range 
where the sensor exists can be defined. 

7. For position and orientation calculation, further select at least the six largest 
5 measurements from the already chosen measurements in step 2 above. 

8. Use a numeric method, e.g. least-square-fit optimization, to find out the position 
and orientation of the sensor. The space range specified in step 6 may be used to 
constrain the search. 

10 

In another embodiment, in order to increase the effective operating space, two or more 
sets of generators could be populated in an extended area. For example, such an area 
could be a floor of a squash court. 

15 As another example, one set of generators could be fitted on the floor of a room and 
another set of generators could be fitted on a wall of the room. The sets of generators do 
not have to be in the same plane. There is also no need to align the axes of the generators 
to the same direction. 

20 Either all the generators of such a matrix can be driven at the same time or only a part of 
them are driven and managed by a power control method. 

The generator coils are set to work under different frequencies. However a particular 
frequency can be reused. One frequency can be used for two or more generators 
25 provided the generators are separated from each other by a distance sufficient to prevent 
effective interference. 



30 



Each frequency bin of the result of the Fourier transform of the sensor signal represents a 
generator coil. As there are more generators than needed to calculate the position, sensor 
position calculation is based on those bins of a Fourier transform with the largest values. 
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Based on the measured position of the sensor, lower power may be supplied to drive the 
generators which are located a substantial distance from the sensor. These generators 
which are located a substantial distance from the sensor, and the magnetic field generated 
5 from these generators contributes little to the 3D position calculation. 

It will be appreciated that the frequency of the generators may be extracted by any 
suitable means, for example a modified form of the Discrete Fourier Transform (MDFT) 
may be used. 

10 

It will be appreciated that a DSP processor may be used as an alternative to the FPGA 
processor. 

The invention is not limited to the embodiments hereinbefore described, with reference to 
15 the accompanying drawings, which may be varied in construction and detail. 



20 
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Claims 



1. A position monitoring system comprising: 



a hardware layer comprising a plurality of electromagnetic generators, at 
least one sensor and a sample processor for generating sample data; and 



a system layer comprising a position processor for generating position data 
from the sample data; 



the system being configured: - 



for simultaneous operation of the plurality of electromagnetic 
generators, with the plurality of electromagnetic generators 
15 operating at different frequencies; and 

for synchronised operation of the plurality of electromagnetic 
generators. 



20 2. A position monitoring system as claimed in claim 1 wherein the plurality of 

electromagnetic generators are configured to operate in a fixed phase relation. 



3. A position monitoring system as claimed in claim 1 or 2 wherein the hardware 
layer comprises a sampling clock, and the system is configured for synchronised 
25 operation of the sampling clock and the plurality of electromagnetic generators. 



4. A position monitoring system as claimed in any of claims 1 to 3 wherein the 
electromagnetic generator is configured to generate an electromagnetic waveform, 
and the electromagnetic generator is configured to generate one or more full 
30 electromagnetic waves within each sampling window. 
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A position monitoring system as claimed in claim 4 wherein the plurality of 
electromagnetic generators are configured such that at the beginning of each 
sampling window the amplitude of all of the generated electromagnetic 
waveforms is equal. 

A position monitoring system as claimed in claim 5 wherein the plurality of 
electromagnetic generators are configured such that at the beginning of each 
sampling window the amplitude of all of the generated electromagnetic 
waveforms is zero. 

A position monitoring system as claimed in any of claims 1 to 6, wherein the 
sensor is configured to be mounted on an object, the position of which is desired 
to be monitored. 

A position monitoring system as claimed in any of claims 1 to 7, wherein at least 
one sensor is of the magnetoresistive effect type. 

A position monitoring system as claimed in any of claims 1 to 8 wherein the 
electromagnetic generator comprises a coil generator. 

A position monitoring system as claimed in claim 9 wherein the electromagnetic 
generator comprises a set of 3-D generator coils. 

A position monitoring system as claimed in any of claims 1 to 10 wherein the 
plurality of electromagnetic generators are driven by an oscillator circuit. 

A position monitoring system as claimed in claim 1 1 wherein the oscillator circuit 
comprises a synchronous oscillator circuit. 
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A position monitoring system as claimed in claim 11 or 12 wherein the oscillator 
circuit is configured for control of the oscillating frequency and phase by a 
reference signal. 

A position monitoring system as claimed in any of claims 1 to 13 wherein the 
hardware layer comprises at least one reference sensor at a fixed position relative 
to the plurality of electromagnetic generators. 

A position monitoring system as claimed in any of claims 1 to 14, wherein the 
sample processor is configured to generate a series of readings for a channel from 
each sensor. 

A position monitoring system as claimed in any of claims 1 to 15, wherein the 
sample processor is configured to extract the components of a signal, received 
from the sensor, corresponding to each generator. 

A position monitoring system as claimed in claim 16, wherein the sample 
processor is configured to frequency multiplex the signal received from the 
sensor. 

A position monitoring system as claimed in any of claims 1 to 17 wherein each 
electromagnetic generator is configured to operate at a unique frequency. 

A position monitoring system as claimed in any preceding claim, wherein the 
sample processor comprises a Discrete Fourier Transform (DFT) function for 
generating sample data. 

A position monitoring system as claimed in claim 19, wherein the sample 
processor comprises an interface for receiving digitised sensor samples and an 
input buffer for retrieving sample words in parallel from the interface. 
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21. A position monitoring system as claimed in claim 20, wherein the interface shifts 
bits as fresh bits are received, and the input buffer retrieves words of a pre- 
configured length. 

22. A position monitoring system as claimed in any of claims 19 to 21, wherein the 
sample processor comprises a vector table for providing parametric data to the 
DFT function. 



10 23. A position monitoring system as claimed in claim 22, wherein the parametric data 

is calculated according to frequency of operation of the generators and sampling 
frequency. 

24. A position monitoring system as claimed in any of claims 19 to 23, wherein the 
15 DFT function windows time series incoming samples with a band limited 

waveform. 

25. A position monitoring system as claimed in any preceding claim, wherein the 
sample processor comprises an FPGA. 

20 

26. A position monitoring system as claimed in any of claims 1 to 24 wherein the 
sample processor comprises a DSP. 

27. A position monitoring system as claimed in any preceding claim, wherein the 
25 system layer comprises an embedded processor. 

28. A position monitoring system as claimed in any of claims 1 to 27 wherein the 
position processor is configured to generate the position data using only some of 
the sample data. 



30 
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29. A position monitoring system as claimed in claim 28 wherein the position 
processor is configured to generate the position data using only the sample data 
having the largest amplitude. 

5 30. A position monitoring system as claimed in any preceding claim, wherein the 

position processor is configured to generate position data by: 

(a) estimating three-dimensional position and orientation data; 

10 (b) determining actual three-dimensional position and orientation data; 

(c) determining speed of movement; and 

(d) using the results of steps (b) and (c) of a previous measurement iteration 
15 as an input to step (a) of a next measurement iteration. 



31. A position monitoring system as claimed in claim 30, wherein step (b) is 
performed with recursive computing. 

20 32. A position monitoring system as claimed in claim 30 or 31 wherein the position 

processor is configured to limit the range of the position calculation by: 



25 where: 



V s = amplitude of a signal received from the sensor; 



R = distance between the sensor and a generator; 



30 



WO 2004/096042 



PCT/IE2004/000062 



10 



-30- 



k c , k s = constants; 



Dx, Dy, Dz = three-dimensional position of the sensor; 



a = orientation of the sensor. 



33. A position monitoring system as claimed in any of claims 1 to 32 wherein the 
hardware layer is configured to supply power to each electromagnetic generator at 
a power level responsive to the position data generated by the position processor. 

34. A position monitoring system as claimed in any of claims 1 to 33 wherein the 
hardware layer is configured to enable the frequency, at which each 
electromagnetic generator may be operated, to be altered. 

15 35. A position monitoring system as claimed in claim 34 wherein the system 

comprises means to analyse the difference between a signal from the sensor 
before altering the frequency and a signal from the sensor after altering the 
frequency. 

20 36. A position monitoring system as claimed in any of claims 1 to 35 wherein the 

system comprises an application layer comprising at least one application for 
processing the position data. 

37. A position monitoring system as claimed in claim 36, wherein at least some 
25 applications of the application layer are remote from the system layer. 

38. A position monitoring system as claimed in any of claims 1 to 37 for monitoring 
the position of a probe in a body passageway. 
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39. A position monitoring system as claimed in claim 38 for monitoring the position 
of a colonoscope in a colon. 



40. A position monitoring system substantially as hereinbefore described with 
5 reference to the accompanying drawings. 



41. A method for monitoring the position of an object, the method comprising the 
steps of:- 



10 providing a plurality of electromagnetic generators and at least one sensor; 



20 



25 



arranging in a fixed position either the plurality of electromagnetic 
generators or the at least one sensor; 



15 arranging for either the at least one sensor or the plurality of 

electromagnetic generators to be carried by the object; 



simultaneously operating the plurality of electromagnetic generators, at 
different frequencies, in a synchronised manner; 



generating sample data from the output of the at least one sensor; 



generating position data from the sample data to monitor the position of 
the object. 



42. A method as claimed in claim 41 wherein the plurality of electromagnetic 
generators are operated in a fixed phase relation. 



43. A method as claimed in any of claims 41 or 42 wherein a sampling clock and the 
30 plurality of electromagnetic generators are operated in a synchronised manner. 



WO 2004/096042 



PCT/IE2004/000062 



-32- 



10 



15 



44. A method as claimed in any of claims 41 to 43 wherein the electromagnetic 
generator generates an electromagnetic waveform, and the electromagnetic 
generator generates one or more full electromagnetic waves within each sampling 
window. 



45. A method as claimed in any of claims 41 to 44 wherein the plurality of 
electromagnetic generators are arranged in fixed positions, and the sensor is 
arranged to be carried by the object. 

46. A method as claimed in claim 45 wherein the sensor is mounted on the object. 

47. A method as claimed in any of claims 41 to 46 wherein the plurality of 
electromagnetic generators are driven by an oscillator circuit. 

48. A method as claimed in claim 47 wherein the method comprises the step of using 
a reference signal to control the oscillating frequency and phase of the oscillator 
circuit. 



20 49. A method as claimed in any of claims 41 to 48 wherein the sample data is 

generated by extracting the components of the sensor output corresponding to 
each generator. 



50. A method as claimed in claim 49 wherein the sample data is generated by 
25 frequency multiplexing the sensor output. 



51 



A method as claimed in any of claims 41 to 50 wherein each electromagnetic 
generator is operated at a unique frequency. 
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52. A method as claimed in any of claims 41 to 51 wherein the position data is 
generated using only some of the sample data. 

53. A method as claimed in claim 52 wherein the position data is generated using 
5 only the sample data having the largest amplitude. 



15 



30 



54. A method as claimed in any of claims 41 to 53 wherein the position data is 
generated by: 



10 (a) estimating three-dimensional position and orientation data; 



(b) determining actual three-dimensional position and orientation data; 



(c) determining speed of movement; and 



(d) using the results of steps (b) and (c) of a previous measurement 
iteration as an input to step (a) of a next measurement iteration. 



55. A method as claimed in claim 54 wherein step (b) is performed with recursive 
20 computing. 



56. A method as claimed in claim 54 or 55 wherein the method comprises the step of 
limiting the range of the position calculation by: 



where: 



V s = amplitude of a signal received from the sensor; 
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R = distance between the sensor and a generator; 



k c , k s = constants; 



Dx, Dy, Dz = three-dimensional position of the sensor; 



a = orientation of the sensor. 



57. A method as claimed in any of claims 41 to 56 wherein the method comprises the 
10 steps of supplying power to each electromagnetic generator at a power level 

responsive to the generated position data. 



58. A method as claimed in any of claims 41 to 57 wherein the method comprises the 
step of altering the frequency, at which each electromagnetic generator is 
15 operated. 



59. A method as claimed in claim 58 wherein the method comprises the step of 
analysing the difference between the sensor output before altering the frequency 
and the sensor output after altering the frequency. 



60. A method as claimed in any of claims 41 to 59 wherein the method comprises the 
step of processing the position data to control an application. 



61. A method as claimed in any of claims 41 to 60 for monitoring the position of a 
25 probe in a body passageway. 



62 



A method as claimed in claim 61 for monitoring the position of a colonoscope in 
a colon. 
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63. A method for monitoring the position of an object substantially as hereinbefore 
described with reference to the accompanying drawings. 

5 
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